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ABSTRACT 


Two  Extended  Kalman  Filter  algorithms  for  air-to-air 
passive  ranging  are  proposed,  and  examined  by  computer 
simulation.   One  algorithm  uses  only  bearing  observations 
while  the  other  uses  both  bearing  and  elevation  angles. 
Both  are  tested  using  a  flat-Earth  model  and  also  using  a 
spherical-Earth  model  where  the  benefit  of  a  simple  correc- 
tion for  the  curvature-of-the-Earth  effect  on  elevation  angle 
is  examined.   The  effects  of  varied  angle  measurement 
precision  and  of  varied  range  estimate  accuracy  are  inves- 
tigated.  Both  filters  are  found  to  perform  acceptably  under 
most  conditions,  with  the  bearing-elevation  algorithm 
generally  providing  superior  results. 
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I.   INTRODUCTION 

The  problem  of  Fleet  Air  Defense  and  air  defense  in 
general  is  one  covering  increasingly  large  geographical 
areas  due  to  the  greater  speeds,  ranges,  and  missile  launch 
envelopes  of  potentially  hostile  airborne  attack  platforms. 
Concurrent  with  the  expansion  of  the  physical  size  of  the 
problem  has  been  an  increase  in  its  complexity  particularly 
in  the  area  of  Electronic  Warfare  (EW) . 

A  common  effect  of  EW  is  the  denial  of  range  and  range 
rate  information  by  electronic  jamming  of  the  observer's 
radar  system.   Since  target  range  and  range  rate  must 
generally  be  known  or  at  least  estimated  for  a  fighter  to 
successfully  employ  its  missile  system,  the  fighter  must 
have  some  alternate  means  of  obtaining  that  information. 

An  approach  to  this  problem  is  called  Passive  Ranging 
(PR)  or  passive  Target  Motion  Analysis  (TMA) .   This  might 
involve  one  or  more  observers  using  a  "receive-only"  radar 
mode  or  perhaps  a  highly  directional  infrared  (IR)  sensor. 
It  could  entail  such  things  as:   Ca)  triangulation  of 
bearing  observations  from  more  than  one  observer,  (b)  use  of 
one  or  more  known  target  parameters  (with  continued  bearing 
observations)  to  compute  the  other  parameters,  (c)  use  of 
direct  bearing  and  elevation  angle  observations  in  combination 
with  observations  of  radio  frequency  (RF)  energy  reflected 
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from  the  water  or  Earth's  surface,  and/or  (d)  a  series  of 
observer  maneuvers  used  in  conjunction  with  angular  observations 

Determination  of  a  target's  position  and  motion  by  means 
of  calculations  performed  on  observations  of  only  bearing 
(and  possibly  elevation)  angles  is  confounded  by  the  reality 
that  the  angle  measurements  are  noisy.   That  is,  while  a 
series  of  measurements  may  be  centered  on  the  true  values, 
individual  measurements  will  differ  from  the  true  values  by 
varying  amounts  and  in  a  random  way.   This  type  of  PR  prob- 
lem may  be  thought  of,  then,  as  having  two  major  facets: 
first,  from  the  series  of  measurements  the  observer  must 
make  "best  guesses"  as  to  the  true  angle  values;  and  second, 
using  these  estimates,  he  must  solve  a  dynamic  geometry 
problem  to  ascertain  target  position  and  motion. 

A  "good"  system  for  passive  ranging  will  determine 
target  parameters  using  only  its  own  observations,  but  it 
might  reasonably  be  expected  to  also  make  use  of  any  a 
priori  targeting  information  to  improve  its  speed  and/or 
accuracy  of  solution.   A  method  for  doing  this  is  by  means 
of  a  Kalman  Filter  (KP)  algorithm  in  which  the  prior  infor- 
mation is  utilized  along  with  an  estimate  of  how  accurate 
that  information  is.   The  KF  (or,  more  precisely,  the  Ex- 
tended Kalman  Filter  (EKF)  )  is  successfully  employed  presently 
in  the  submarine  and  surface  ship  anti-submarine  warfare 
communities.   In  this  environment  observations  are  normally 
acoustic  bearing  measurements,  although  the  use  of 
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depression/elevation  angle  with  "bottom-bounce"  reflections 
has  been  utilized  or  proposed. 

Representative  of  current  thinking  on  passive  ranging  as 
an  air-to-air  problem  are  techniques  proposed  by  Ohlmeyer 
[Ref.  1],  and  Stiffler  [Ref.  2],    which  also  rely  on  the  use 
of  EKF's.   Ohlmeyer 's  technique  uses  only  bearing  angle 
information,  whereas  Stiffler  presents  six  different  algorithms 
using  bearing-only  or  a  combination  of  bearing  and  elevation 
angle  observations. 

This  paper  proposes  and  investigates  methods  of  passive 
target  motion  analysis  by  means  of  two  EKF's,  where  both 
bearing-only  and  bearing-elevation  solutions  are  computed 
simultaneously  for  comparison  purposes. 
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II.   THE  KALMAN  FILTER  AND  EXTENDED  KALMAN  FILTER 

A.   THE  KALMAN  FILTER 

The  following  discussion  briefly  describes  Kalman  Filter- 
ing in  general,  the  need  in  our  case  for  the  Extended  Kalman 
Filter,  and  an  application  of  the  EKF  to  the  air-to-air 
passive  ranging  problem.   The  reader  interested  in  a  more 
in-depth  development  of  the  KF  and  EKF  is  referred  to 
References  3,  4,  and  5. 

The  purpose  of  a  KF  is  to  keep  track  of  the  state  of  a 
system  by  means  of  a  sequence  of  noisy  measurements.   This 
is  done  by  recursively  updating  an  estimate  of  the  state  by 
computationally  processing  the  succession  of  noisy  observa- 
tions in  such  a  way  as  to  reduce  as  much  as  possible  the 
effect  of  measurement  errors.   For  our  purposes  we  will 
assume  that  the  object  (target)  whose  state  we  are  esti- 
mating, and  the  observer  (fighter)  exist  in  a  Cartesian 
coordinate  system  and  that  the  state,  S,  is  composed  of  a 
four-  or  five-element  vector  of  the  form: 


S   = 


X 
Y 
X 
Y 


or 


S   = 


X 
Y 
X 
Y 

A 


(2.1) 
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where  X  and  Y  are  the  X  and  Y  components  of  target  velocity, 
X,  Y  and  A  are  the  X,  Y  and  altitude  components  of  target 
position;  and  where  the  true  values  of  X,  Y  and  A  are  assumed 
constant.   Note  that  the  KF  in  general  is  in  no  way  limited 
to  this  type  of  reference  frame  or  state  vector,  and  that 
observations  from  which  the  estimated  state  is  computed  need 
not  have  the  same  dimensionality  or  units  as  the  state 
vector.   In  our  case,  for  instance,  each  observation  will  be 
either  a  bearing  angle  measurement  or  a  vector  of  both 
bearing  and  elevation  angle  measurements. 

The  KF  is  a  predictor-corrector  type  estimator  that 
propagates  an  estimate,  y,  of  the  state,  S,  and  an  associated 
covariance  matrix,  [,  reflective  of  the  accuracy  of  the 
state  estimate.   The  KF  algorithm  is  implemented  in  two 
alternating  stages.   First,  previous  estimates  of  y  and  J^ 
are  extrapolated  one  time-step  ahead  based  on  the  assumed 
system  dynamics;  this  we  will  refer  to  as  the  Movement  Step. 
The  extrapolated  quantities  are  then  used  to  compute  a  set 
of  optimum  weights  called  Kalman  Gains  (simply  proportion- 
ality factors) .   These  are  applied  to  the  prediction  and  to 
a  new  observation  in  a  Measurement  Step,  which  provides  an 
updated  (corrected)  estimate  of  the  state  and  its  covariance. 
The  process  is  then  repeated. 

Symbolically,  the  KF  algorithm  may  be  written  as  follows: 
Movement  Step: 


y    =   <!'  y   ,  +  y  C2.2) 

3  3-1     w 
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L   =   $  L.l  ^'^   +   Q  (2.3) 


Kalman  Gain  computation: 


-1 


K.   =   ^  H  (H  ^  .  H   +  P)  -^  (2.4) 


Measurement  Step: 


Pj   =   Uj  +  K^(Z  -  M^  -  Hy  )  (2.5) 


I.   =   (I  -  K.E)l.  (2.6) 


The  notation  is  as  follows: 

4>  is  the  transition  matrix  which  describes  how  the 
system  state  changes  between  observations, 

H  is  the  transition  matrix  which  describes  how  the 
measurement  depends  on  the  state, 

\s    ,    Q ,    11    ,    and  P  are  respectively,  movement  noise  mean 
and  covariance,  and  measurement  noise  mean  and  covariance. 
(Note  that  movement  noise  and  measurement  noise  are  assumed 
to  be  normally  distributed  random  variables,  i.e., 
W  ~  N(y  ,Q)  and  V  -  N(y  ,P) ) .   We  will  generally  assume  here 

that  y  ,  Q,  and  y   are  zero. 

w  V 

K  is  the  Kalman  Gain, 

Z  is  the  observation  (measurement) , 

I  is  the  identity  matrix. 
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j  is  the  observation  time  index, 
T  (as  superscript)  indicates  transpose, 
~  and  ^  indicate  estimates  after  Movement  and  Measure- 
ment, respectively. 

B.   THE  EXTENDED  KALMAN  FILTER 

The  above  described  KF  is  appropriate  when  both  the 
movement  and  measurement  models  are  linear  functions  of  the 
state  variables.   We  have,  however,  a  non-linear  measurement 
function  since 

Z   =   h(S)  +  V 

where  the  measurement,  Z,  is  a  function,  h(S) ,  of  system 
state  plus  some  noise  (error) ,  V,  and  where  h  is  composed  of 
one  (or  two)  arctangent  functions  of  state  vector  elements. 
We  have: 


h(S) 


tan 


-1  AX 
AY 


in  the  bearing-only  case,  and 


h(S)   = 


tan 


tan 


AX 
AY 


AA 


2    2  1/2 

(AX^+AY  )  / 


in  the  bearing- 
elevation  case, 


where  AX,  AY,  and  AA  are,  respectively,  the  X,  Y  and  altitude 
differences  between  fighter  and  target  positions. 

Since  the  measurement  in  both  the  bearing-only  and 
bearing-elevation  cases  is  a  non- linear  function  of  the 
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current  state  vector,  the  measurement  transition  matrix  H 
in  the  KF  algorithm  must  somehow  be  "linearized".   This  is 
accomplished  by  expanding  h  in  a  Taylor  Series  about  a  known 
vector  that  is  close  to  the  true  state  S.   For  this  known 
vector  we  will  use  y ,  our  current  estimate  of  S.   Truncating 
after  the  first  two  terms  of  the  Taylor  Series  we  have  that 


h(S)   =   h(y)  +  9h(S)/3S 


S=y 


The  effect  on  the  KF  algorithm  is  that  in  Equation  2.5 
Hy  .  is  replaced  by  the  function  h()j.)  which  is  the  measure- 
ment vector  as  a  function  of  the  state  estimate,  and  in 

Equation  2.4  and  2.6  H  =  8h(S)/3S     .   One  condition  re- 

s=y 
quired  here  is  that  the  estimate  be  unbiased,  i.e.,  y  , 

the  estimated  value  of  V,  must  be  zero  [Ref .  3] . 

This  extension  of  the  KF  to  the  non-linear  case  is 
appropriately  called  the  Extended  Kalman  Filter  (EKF) . 
Higher  order,  more  precise  approximations  to  the  optimal 
non- linear  filter  can  be  achieved  using  more  terms  of  the 
Taylor  Series  expansion  for  the  nonlinearities ,  and  by 
deriving  recursive  relations  for  the  higher  moments  of  S. 
See  Reference  3  for  a  discussion  of  methods  of  this  type. 

The  (non-extended)  Kalman  Filter  is  optimal  when  its 
assumptions  are  valid  [Ref.  6 J ,  however,  this  is  not  neces- 
sarily true  of  the  EKF.   Since,  in  our  case  for  instance, 
the  measurement  transition  matrix  H  both  depends  on  the 
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current  state  estimate  and  is  used  to  obtain  revised  state 
estimates,  there  is  a  potential  for  bad  estimates  to  get 
worse  and  for  complete  loss  of  track  to  occur  [Ref.  7]. 
Also,  the  matrix  I    is  only  an  approximation  to  the  true 
covariance  matrix  and  is  not  always  an  accurate  indicator  of 
the  estimation  errors.   Fortunately,  however,  the  EKF  has 
been  found  to  perform  well  in  a  number  of  practical  applica- 
tions [Ref.  3]  including  passive  ranging. 

The  design  of  practical,  operational  filters  "is  an  art 
wherein  one  attempts  to  retain  the  behaviour  of  the  EKF  when 
things  are  going  well,  while  simultaneously  being  able  to 
recognize  and  correct  for  incipient  loss  of  track"  [Ref.  7] . 
Techniques  for  doing  this  (and  cautions)  are  discussed  later 
and  in  References  1,  3  and  8. 

C.   FUNCTIONS  AND  MATRICES 

Functions  and  matrices  are  given  here  for  the  bearing- 
elevation  cases.   Those  for  the  bearing-only  cases  are 
exactly  the  same,  but  excluding  the  last  Cfifth)  element 
in  the  case  of  a  vector,  and  the  last  row  and  column  in  the 
case  of  a  matrix. 

With  jj  as  the  estimate  of  the  state  vector 
S  =  [X,Y,X,y,A]  ,  we  have  that  the  movement  function 
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g(s) 


'  X.    ^ 

1 

^i-1 

Wi  - 

^i-1 

S=y 

^i  - 

^i-1 

+ 

AtX,., 

^i " 

^i-1 

+ 

"*i-l 

[a.   ^ 

^-1 

SO  the  movement  matrix  is 


$   = 


1 

0 

0 

0 

0 

0 

1 

0 

0 

0 

1 

0 

1 

0 

0 

0 

1 

0 

1 

0 

0 

0 

0 

0 

1 

The  covariance  matrix  is 


I   = 


a? 
X 

0 

0 
2 

0 
0 

0 
0 

0 
0 

0 

0 

2 

^X 

0 

0 

0 

0 

0 

2 

^Y 

0 

0 

0 

0 

0 

a 

The  measurement  function  is 


h(S) 


S=p 


tan   (   .p  ) 

My     ^Y 


tan   ( ) 
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2  2  1/2 

where  y ^  =  ( ( y^-F^)   -  (yY-F^)  )    ,  and  where  F^,  F^,  and 

F,  are,  respectively,  the  fighter's  known  X,  Y,  and  altitude 

positions,  so  the  measurement  matrix  is 


H(S) 


S=y 


2 

2 

"r 

-<V^a'  'V^y* 
'^^r^'V^a'^'^^r 

0 

^R 

'4^(V^a)''^r 

4^ 

(V^a)' 
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III.   PARAMETERIZATION  AND  ASSUMPTIONS 

A.  FIGHTER  AND  TARGET  FLIGHT  PATHS 

For  all  simulated  tracking  sessions  the  fighter  utilizes 
a  "zig-zag"  pattern  as  described  in  Appendix  B  and  illus- 
trated in  Figure  3.1.   Briefly,  this  pattern  has  the  fighter 
initially  turn  so  as  to  have  the  first  bearing  observation 
0.7  radians  (about  40°)  right  of  dead  ahead,  hold  this 
heading  for  1  minute,  then  turn  to  put  the  most  recent  bearing 
0.7  radians  left,  now  continuing  for  2  minutes.   Alternating 
2-minute  legs  are  continued  until  a  specified  number  of 
observations  have  been  taken,  or  until  the  target  passes  by 
the  fighter.   The  target,  meanwhile,  in  all  cases  maintains 
a  non-turning  constant  altitude  track.   For  the  computer 
simulation  runs  each  tracking  session  is  limited  to  5  minutes 
(61  observations  at  5-second  intervals). 

B.  INITIAL  PARAiMETERS 

Eighteen  different  combinations  of  P  and  J^    values  (that 
is,  covariances  for  observation  error  and  state  estimate) 
are  utilized  for  initial  parameterization  in  the  simulations. 
The  runs  are  first  done  using  the  "flat-Earth"  motion  model, 
then  they  are  all  repeated  using  the  spherical-Earth  model 
with  an  elevation  angle  correction  (Appendix  D) ,  then  twelve 
cases  are  simulated  using  the  spherical-Earth  model  without 
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Figure  3.1.   Fighter  and  Target  Flight  Paths 
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the  elevation  correction,  and  finally,  three  cases  are  simu- 
lated where  a  5"  constant  bias  is  added  to  the  angle  measure- 
ments.  1000  replications  of  each  set  are  run  for  both  the 
bearing-only  and  bearing-elevation  cases.   In  all  cases  the 
target,  at  time  0,  is  at  80  nautical  miles  (nm)  range,  heading 
directly  toward  the  fighter  at  an  altitude  of  7nm  (42,532 
feet)  and  a  ground  speed  of  500  knots.   The  fighter  maintains 
an  altitude  of  3nm  and  a  ground  speed  of  300  knots.   The  EKF 
initial  estimates  of  target  state  for  each  run  are  varied 
randomly  according  to  a  multivariate  normal  distribution 
centered  at  the  correct  values,  and  with  covariance  as  stated 
below. 

At  each  observation  the  bearing-only  (BO)  and  bearing- 
elevation  (BE)  EKF's  are  fed  identical  random  azimuth 
measurements,  while  the  BE  EKF  additionally  gets  random  ele- 
vation angle  measurements.   The  random  measurements  are 
generated  by  adding  to  the  true  angle  a  random  number  from 

a  normal  distribution  with  mean  0  and  variance  P. 

2    2        2     2  2 

The  P-values  used  are  5,2,1,  .5,.l,  and  .02 

2 
degrees  ,  where  these  values  apply  to  both  bearing  and, 

where  applicable,  elevation  measurements.   For  example,  in 

the  first  set  of  bearing-only  simulations  P  =  [25]  whereas  for 

25   0 
the  bearmg-elevation  runs  P  =  [  -^  ^^]  .   We  assume  here 

that  both  bearing  and  elevation  measurements  have  the  same 

magnitude  and  distribution  of  errors  (normal) ,  and  that 

they  are  independent  of  each  other . 
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The  initial  estimate  of  the  covariance  matrix  has  diagonal 

2  2    2  2    2       2 

values;   a-  =  1000  knots  ,    a-  =  250,000  knots  ,  a   =  4nm  , 

AY  A 

2       2  2  2  2 

and  a,  =  4nm  ,  while  a„  is  varied  from  1600nm   to  400nm 
A  Y 

2 
to  lOOnm   for  the  different  cases.   The  choices  for  these 

values  as  well  as  for  the  P-values  are  somewhat  arbitrary 

and  their  validity  will  not  be  argued  here.   The  reader  is 

referred  to  Appendix  B  for  a  description  of  how  the  reference 

frames  (coordinate  systems)  are  defined,  and  of  how  true 

positions  and  observation  angles  are  computed. 

C.   ASSUMPTIONS 

For  EKF  computer  simulations  the  following  assumptions 
are  made : 

(1)  The  observer  (fighter)  knows  his  own  position, 
course  and  speed  precisely. 

(2)  Maneuvers  are  instantaneous;  there  is  neither  time 
loss  nor  positional  change  associated  with  the 
observer's  course  changes. 

(3)  The  target  holds  a  constant  course,  speed  and 
altitude,  while  the  fighter  holds  constant  speed 
and  altitude. 

(4)  There  is  no  refraction  or  other  distortion  of  the 
radiated  energy. 

(5)  Angle  measurement  errors  in  elevation  and  in  azimuth 
have  a  Gaussian  (normal)  distribution  with  zero  mean 
and  known  variance.   Errors  are  assumed  to  be  inde- 
pendent of  range. 
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IV.   SIMULATION  RESULTS  AND  OBSERVATIONS 

A.   TABLES 

Results  of  the  computer  simulations  are  summarized  in 
Tables  I-IV  which  are  for,  respectively,  the  planar  ("flat- 
Earth")  motion  model,  the  spherical-Earth  motion  model  with 
elevation  angle  correction,  the  spherical  model  without 
elevation  angle  correction,  and,  finally,  the  spherical 
model  with  elevation  angle  correction,  but  with  a  constant 
angle  bias  inserted  into  the  observations.   Data  in  the 
tables  are  categorized  by  initial  range  variance,  and  for 
each  range  variance  the  different  selections  of  angle  measure- 
ment precision  are  represented,  with  data  from  the  bearing- 
only  EKF  on  the  left  and  from  the  bearing-elevation  EKF  on 
the  right. 

Comparison  data  are  the  proportions  of  dropped  tracks 
using  three  different  criteria.   First  is  the  "e  >  3a"  column, 
which  lists  the  proportion  of  runs  in  which  actual  range 
error  was  greater  than  the  3  standard  deviations  as  estimated 

by  the  EKF,  i.e.,  e  =  JR-RJ  >  3a.   (See  Appendix  A  for  a 

2 
description  of  computations  of  R  and  0^^.)      The  "Rg"  column 

i\ 

lists  as  dropped  tracks  those  for  which  the  final  range  esti- 
mate is  in  error  by  more  than  25%  of  the  true  range,  and  the 
"Rg-Vel"  column  lists  those  for  which  either  range  or 
velocity  are  in  error  by  more  than  25%  of  actual  values. 
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TABLE  I 
Simulation  Results — "Flat-Earth"  Motion  Model 

Proportion  of  Droppeci  Tracks 
(by  criterion) 

1000  Replications 

Bearing-only  Bearing  &  Elevation 


Initial  Ran 

ge  Variance  =  J^(4,4) 

2   2 
=  40'^nm 

P 

2 

Degrees 

Measurement 

£>3a 

Rg-Vel 

Rg 

Precision 

£>3a 

Rg-Vel 

Rg 

0.188 

0.949 

0.732 

2^ 

0.075 

0.880 

0.554 

0.085 

0.757 

0.452 

0.047 

0.473 

0.169 

0.094 

0.480 

0.175 

5^ 
.02^ 

0.073 

0.206 

0.059 

0.124 

0.235 

0.109 

0.118 

0.137 

0.076 

0.217 

0.179 

0.128 

0.208 

0.153 

0.092 

0.387 

0.177 

0.138 

0.439 

0.168 

0.096 

I 

(4, 

,4)  =  20 ^nm 

2 

£>3a 

Rg-Vel 

Rg 

P 

£>3a 

Rg-Vel 

Rg 

0.121 

0.904 

0.710 

^2 

0.042 

0.781 

0.504 

0.017 

0.664 

0.329 

0.004 

0.347 

0.096 

0.006 

0.328 

0.050 

h 

5 

■p 

2 
.02^ 

0.004 

0.038 

0.001 

0.010 

0.083 

0.001 

0.006 

0.009 

0.001 

0.066 

0.029 

0.007 

0.041 

0.016 

0.003 

0.241 

0.029 

0.007 

0.184 

0.012 

0.001 

I 

(4, 

,4)  =  lO^nm 

2 

£>3a 

Rg-Vel 

Rg 

P 

£>3a 

Rg-Vel 

Rg 

0.131 

0.858 

0.713 

P 

0.032 

0.701 

0.484 

0.017 

0.501 

0.293 

0.002 

0.203 

0.071 

0.011 

0.239 

0.030 

2 

0.001 

0.018 

0.000 

0.003 

0.039 

0.000 

0.004 

0.000 

0.000 

0.014 

0.002 

0.000 

0.006 

0.000 

0.000 

0.107 

0.001 

0.000 

0.037 

0.000 

0.000 
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B.   OBSERVATIONS 

Some  immediate  observations  can  be  made  from  the  tables: 

1.  From  Table  I  ("flat-Earth"  Motion  Model) ,  the  bearing- 
elevation  results  appear  superior  to  those  for  bearing-only 
for  every  set  of  parameters  when  using  either  the  range- 
velocity  or  range  error  criteria,  and  they  are  generally 
superior  when  using  the  e  >  3a  criterion  as  well.   It  should 
be  noted,  however,  that  in  all  of  the  cases  represented  the 
fighter-target  altitude  difference  is  held  at  4nm  (about  24,000 
ft) .   The  advantage  of  BE  over  BO  was  shown  by  limited  addi- 
tional simulations  to  disappear  as  the  altitude  difference 
went  to  zero. 

2 .  Improvement  in  the  accuracy  of  the  initial  range 

estimate  (decrease  in  the  variance  [(4,4))  from  40   to  20  , 

2   2 
and  then  to  10  nm  has  a  positive  effect  in  decreasing  the 

proportion  of  dropped  tracks  as  one  might  reasonably  expect. 

3.  Improvement  in  angle  measurement  precision  (variance 

P)  generally  improves  the  EKF's  ability  to  track.   It  seems 

2 
evident,  for  instance,  that  P  =  5   is  impractical  from  an 

operational  standpoint  since  neither  EKF  could  determine 

target  range  and  velocity  within  2  5%,  even  30%  of  the  time 

regardless  of  initial  range  variance.   It  is  interesting  to 

note  that  the  e  >  3a  dropped  track  criterion  for  the  BE 

2 

EKF  for  P  =  5   is  exceeded  in  a  much  lower  (2-10%)  proportion 

of  the  cases  than  are  the  range  and  range-velocity  standards 
(50-95%) .   This  is  a  valuable  trait  in  that,  although  the 
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TABLE    II 

Simulation   Results — Spherical   Motion  Model 
with   Elevation   Correction 


Proportion   of   Dropped   Tracks 
(by    criterion) 


1000    Replications 


Bearin 

ig-only 

Bearing    &    Elevation 

Initial    Range 

Variance   = 

1(4,4)    = 

40^nm^ 

P  Degrees 

Measurenent 

£>3a 

Rg-Vel 

Rg 

Precision 

£>3a 

Rg-Vel 

Rg 

0.255 

0.937 

0.751 

2"^ 

0.121 

0.878 

0.592 

0.082 

0.718 

0.370 

0.073 

0.466 

0.195 

0.076 

0.458 

0.145 

.02^^ 

0.085 

0.159 

0.049 

0.125 

0.224 

0.106 

0.160 

0.139 

0.075 

0.231 

0.178 

0.120 

0.440 

0.179 

0.111 

0.393 

0.170 

0.129 

0.858 

0.262 

0.174 

I    (4,4)    =  20^nm^ 


£>3a 


Rg-Vel         Rg 


e>3a 


I^-Vel 


Rg 


0.238 

0.919 

0.752 

P 

0.122 

0.808 

0.542 

0.027 

0.626 

0.252 

0.010 

0.291 

0.078 

0.013 

0.350 

0.049 

.02^ 

0.012 

0.043 

0.004 

0.018 

0.084 

0,007 

0.034 

0.013 

0.003 

0.065 

0.027 

0.008 

0.247 

0.012 

0.006 

0.221 

0.028 

0.006 

0.801 

0.078 

0.045 

I    i 

L4,4) 

=  lO^nm^ 

£>3a 


Rg-Vel         Rg 


e>3a 


Rg-Vel 


Rg 


0.238 

0.842 

0.721 

P 

0.083 

0.663 

0.478 

0.024 

0.478 

0.233 

0.003 

0.203 

0.066 

0.004 

0.219 

0.023 

.Q2 

0.005 

0.015 

0.000 

0.003 

0.047 

0.000 

0.006 

0.000 

0.000 

0.012 

0.001 

0.000 

0.142 

0.000 

0.000 

0.088 

0.000 

0.000 

0.742 

0.059 

0.050 
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EKF  estimates  of  target  state  are  not  very  accurate,  the 

EKF  is  apparently  "aware"  of  this  since  its  estimated  range 

variance  is  evidently  high.   Since  the  state  covariance 

matrix  is  available  to  the  user,  he  should  generally  be 

able  to  determine  the  worth  of  the  estimated  state  information 

4.   This  characteristic  does  not  necessarily  hold  true 
when  measurement  precision  is  extremely  high,  however;  in 
fact,  it  becomes  less  true  as  P-values  are  decreased  below 
.5^  for  these  EKF's  (e.g.,  Table  I,  ^(4,4)  =  40^  and  P  =  .02^), 
A  similar  observation  was  made  in  Reference  6.   This  apparent 
EKF  trait  may  be  explained  by  the  Taylor  Series  approxima- 
tion used  to  linearize  the  Measurement  Function  (Chapter 
II)  inducing  more  error  than  that  added  by  the  noisiness  of 
the  bearing  measurements.   The  EKF-estimated  range  variance 
becomes  relatively  small  because  of  the  precise  measurements, 
but  the  actual  range  errors  are  not  correspondingly  reduced 
apparently  because  of  the  EKF  linearization  approximation. 
Practical  results  are  still  quite  good  as  evidenced  by  the 
still  relatively  small  proportion  of  dropped  tracks  using 
the  range  and  range-velocity  criteria.   With  a  longer  obser- 
vation period,  however,  we  might  expect  the  estimated 
range  variance  to  continue  its  decrease  relative  to  the 
squared  range  error  (covariance  collapse) ,  and  we  would 
anticipate  more  tracks  being  dropped.   A  possible  solution  to 
this  problem,  if  highly  precise  angle  measurements  are 
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TABLE  III 

Simulation  Results — Spherical  Motion  Model 
Without  Elevation  Correction 


Proportion  of  Dropped  Tracks 
(by  criterion) 


1000  Replications 


Bearing-only  Bearing  &  Elevation 

2       2 

Initial    Range   Variance   =  [    (4,4)  =    40    nm 

P  Degrees 2 
Measurement 

£>3a         Rg-Vel            Rg          Precision  z>3o  Rg-Vel  Rg 

0.079       0.726            0.356                  2^  0.079  0.477  0.126 

0.071       0.420            0.127                  1  0.137  0.239  0.055 

0.108       0.205           0.090                .5^  0.372  0.130  0.071 

0.219       0.017           0.129                .1^  0.998  0.166  0.117 

I    (4,4)   =  20^nm^ 

£>3a    Rg-Vel     I^        P  £>3a  Rg-Vel  Rg 

0.035       0.609            0.254                  2^  0.028  0.336  0.044 

0.069       0.156           0.002                  1  0.069  0.156  0.002 

0.011       0.073           0.006                .5^  0.312  0.022  0.002 

0.053       0.017           0.002                .1^  1.000  0.005  0.002 


I    (4,4)   =  10 


2     2 

nm 


£>3a  Rg-Vel  Pg  P  £>3a  Rg-Vel  Rg 

0.023  0.502  0.237  2^  0.027  0.226  0.050 

0.002  0.222  0.017  1  0.065  0.098  0.000 

0.006  0.041  0.000  .5^  0.328  0.019  0.000 

0.008  0.001  0.000  .1^  1.000  0.000  0.000 
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TABLE  IV 

Simulation  Results — Spherical  Motion  Model 
with  Measurement  Bias 


Proportion  of  Dropped  Tracks 
(by  criterion) 

1000  Replications 


Bearing-only  Bearing  &  Elevation 

Initial  Range  VAriance  =  I    (4,4)  =  40  nm 

2 

Measurement   Precision  =   P   =    .5 


£>3a  Pg-Vel  Rg 

0.132  0.238  0.113 

0.991  0.999  0.989 

0.985  0.999  0.986 


AZ 

Elev 

Mas 

Bias 

£>3a 

Rg-Vel 

Bg 

0 

5 

0.520 

0.838 

0.235 

5 

0 

0.865 

0.951 

0.759 

5 

5 

0.747 

0.998 

0.749 

available,  would  be  to  use  a  higher  order  Taylor  Series 
approximation  as  previously  suggested. 

5.   A  comparison  of  Tables  I  and  II  indicates  that  spheri- 
cal motion  target  data  can  be  accommodated  by  the  flat- 
Earth  EKF  when  an  appropriate  elevation  angle  correction 
is  applied.   At  the  very  high  precision  levels,  however, 
there  is  a  notable  degradation  with  the  BE  EKF  results, 
especially  when  using  the  e  >  3a  criterion.   This  is  apparently 
due  to  the  filter  being  "confused"  by  highly  accurate 
measurements  which  are  "corrected"  by  an  elevation  angle 
correction  (for  Earth's  curvature)  which  is  no  longer 
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adequate.   The  result  is  that  estimated  range  variance  is 
considerably  smaller  than  actual  range  variance. 

6.  A  comparison  of  Tables  II  and  III  indicates  that  the 
BE  EKF  is  somewhat  improved  when  using  the  elevation  angle 
correction  to  allow  for  the  Earth's  curvature,  but  the  filter 
without  the  correction  still  performs   almost  as  effectively. 

(The  BO  EKF,  of  course,  is  not  affected  by  the  correction 
since  it  does  not  use  elevation  angle  as  an  input) .   As 
angle  measurement  precision  increases,  the  positive  effect 
of  an  elevation  angle  correction  to  the  BE  EKF  also  increases, 
however  (e.g..  Tables  I  and  II,  J[  ( 4 , 4 )  =  40^,  P  =  .1^). 

7.  Table  IV  illustrates  the  effects  of  biased  measure- 
ment data  on  EKF  performance.   When  azimuth  angle,  or  both 
azimuth  and  elevation  angles  have  a  bias,  then  neither 
filter  operates  effectively.   When  only  the  elevation  angle 
is  biased  the  BE  EKF  performance  is  severely  degraded.   Only 
the  P  =  .25  measurement  precision  was  investigated;  it  was 
felt  to  be  a  good  test  case  since  it  consistently  produced 
among  the  best  results  with  unbiased  inputs . 

C.   TIME  SEQUENCE  PLOTS 

Figure  4.1  is  a  set  of  plots  showing  a  time  sequence  of 
range  errors  during  the  5  minutes  of  tracking.   The  median 
values  of  range  errors  are  represented  for  the  1000  repli- 
cations of  each  of  the  different  levels  of  measurement  pre- 
cision (P) .   A  representative  set  of  plots  are  shown  in 
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Figure  4.1.   Median  Range  Error  Vs.  Time-- "Flat-Earth" 
Model,  Range  Variance  =  lOOnm^ 
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Figure  4.1  which  are  for  the  "flat-Earth"  motion  model  with 

2 
range  variance  of  lOOnm  .   Similar  plots  for  the  other  sets 

of  parameters  are  included  at  the  end  of  the  chapter.   Note 

that  the  horizontal  axis  is  not  always  at  zero  range  error, 

and  that  the  vertical  scales  differ  among  plots.   In  each 

plot  the  solid  line  represents  BO  EKF  results,  whereas  the 

dotted  line  represents  those  from  the  BE  EKF. 

Several  important  features  of  the  EKF's  are  illustrated 

by  the  plots: 

1.  The  BE  EKF  is  again  seen  to  be  generally  superior  to 
the  BO  EKF.  The  major  advantage  of  the  BE  EKF  seems  to  be 
the  generally  greater  speed  with  which  the  estimated  range 
converges  to  true  range  particularly  in  the  lower  measure- 
ment precision  cases.   At  very  fine  measurement  precision 

2 
(P  =  .01  and  P  =  .0004  degrees  )  there  seems  to  be  little 

if  any  advantage  to  using  both  bearing  and  elevation  angles. 

2.  In  all  cases  the  trend  seems  to  be  toward  better 
convergence  with  time,  once  the  initial  transients  have 
disappeared.   This  suggests  that  even  in  those  cases  where 

a  large  proportion  of  the  runs  are  "dropped  tracks"  according 
to  the  range  or  range-velocity  criterion,  additional  tracking 
time,  if  available  ,  would  bring  increasing  numbers  into 
convergence.   Limited  additional  computer  simulations  seemed 
to  bear  this  out. 

3.  The  "humps"  which  are  especially  prominent  in  the 

2  2 

P  =  2  ,  1,  and  .5   cases  occur  at  about  2  and  4  minutes. 
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They  indicate  that  range  error  is  decreasing  from  time  0  to 
1,  increasing  from  time  1  to  2 ,  decreasing  again  from  2 
to  3,  etc.   Referring  to  Figure  3.1  (Fighter  and  Target 
Flight  Paths)  the  convergence  of  estimated  range  to  true 
range,  then,  appears  to  increase  as  the  rate  of  bearing 
change  increases.   This  is  consistent  with  the  well  known 
(among  submariners)  result  that  in  passive  ranging  "the 
greater  the  time  rate  of  change  of  bearing  the  more  accurate 
the  range  estimate"  [Ref .  9] .   This  rate  is  slowest  (with 
this  particular  geometry)  when  the  fighter  first  turns  in 
toward  target  flight  path,  increasing  until  he  next  turns  in 
from  the  opposite  side  of  target  flight  path.   The  humps, 
then,  roughly  coincide  with  the  times  at  which  the  fighter 
is  turning  back  in,  i.e.,  the  times  when  bearing  change 
rate  is  relatively  low. 

4.   It  is  evident  that  the  time  to  convergence  is  greatly 

affected  by  angle  measurement  precision.   Note  that  in  the 

2 
P  =  .02   case  convergence  is  extremely  rapid  after  1  minute, 

which  is  the  time  of  the  first  fighter  turn.   This  suggests 
that  in  the  case  of  extremely  good  precision,  convergence 
time  can  be  even  further  decreased  by  making  the  fighter's 
first  turn  earlier,  or  perhaps  having  the  fighter  maintain 
a  constantly  turning  flight  path  such  as  the  "sine  wave" 
flight  path  proposed  by  Ohlmeyer  [Ref.  IJ .   Limited  addi- 
tional simulations  with  the  fine  precision  and  an  earlier 
turn  did,  in  fact,  indicate  that  convergence  time  would  be 
reduced. 
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Median  Range  Error  Vs.  Time — "Flat-Earth" 
Model,  Range  Variance  =  1600nm 
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Median  Range  Error  Vs.  Time — "Flat- 
Earth"  Model,  Range  Variance  =  400nm2 
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Model,  Range  Variance  =  4  00nm2 
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Median  Range  Error  Vs.  Time — Spherical 
Model,  Range  Variance  =  lOOnm^ 
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Median  Range  Error  Vs.  Time — Spherical 
Model  (No  Elev.  Correction) ,  Range 
Variance  =  1600nm2 
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Median  Range  Error  Vs.  Time — Spherical 
Model  (No  Elev.  Correction) ,    Range 
Variance  =  400nin2 
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Median  Range  Error  Vs.  Time — Spherical 
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V.       CONCLUSIONS    AND    RECOI^ENDATIONS 

A.  CONCLUSIONS 

Computer  simulations  using  the  two  EKF  algorithms 
presented  here  demonstrate  that  both  have  the  potential 
to  be  valuable  tools  for  air-to-air  passive  ranging  as 
long  as  their  assumptions  are  met.   The  bearing-elevation 
EKF  generally  performs  better  than  the  bearing-only  EKF 
when  the  fighter  and  target  have  a  significant  separation 
in  altitude. 

B.  RECOMMENDATIONS 

There  are  several  possible  EKF  modifications  which  seem 
to  offer  potential  in  improving  its  performance.   Some  of 
these  are: 

1.   Filter  re-initialization  when  it  is  determined  to 
be  grossly  in  error.   Aidala  [Ref.  8J ,  discusses  ways  in 
which  "premature  covariance  collapse"  can  be  recognized. 
He  notes  that  onset  of  this  malady,  which  usually  leads 
to  a  dropped  track,  often  occurs  after  only  two  initial 
measurements.   This  suggests  that  if  it  can  be  recognized 
there  would  normally  be  ample  time  to  restart  the  EKF.   He 
also  cautions  that  some  "previous  attempts  to  prevent  ab- 
normal filter  behavior  have  proved  ineffectual  when  sub- 
jected to  rigorous  testing .. .because  they  focus  only  on 
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the  symptoms  of  the  problem  (rather  than)  the  underlying 
causes"  [Ref .  8] . 

2.  Filter  self-correction  when  obtaining  "unbelievable" 
results.   Although  this  may  fall  into  the  category  of 
treating  the  "symptom"  rather  than  the  ailment,  it  seems 
reasonable  to  put  some  bounds  on  the  acceptable  estimated 
target  state  based  on  physical  knowledge.   The  most  obvious 
limit  would  apply  to  a  low  target;  for  example  a  fighter 

at  an  altitude  of  3nm  with  a  target  elevation  observation  of 
-4°  could  immediately  deduce  that  the  target  is  (depending 
on  measurement  precision)  no  farther  away  from  him  than 
R  <_  3  CSC  4°  =  43nm,  since  he  can  generally  be  ass^mied  to 
be  above  the  Earth's  surface,  so  it  would  seem  futile  to 
waste  more  time  estimating  him  at,  say,  80nm.   Similarly, 
the  maximum  altitude  of  a  target  faay   be  known,  as  well  as 
possible  limits  on  speeds,  ranges,  or  headings.   These 
things  would  be  scenario-dependent  and  would  probably  re- 
quire aircrew  inputs  and  reasonable  default  values. 

3.  Increased  frequency  of  observations  (filter  cycle 
rate) .   A  five-second  interval  was  chosen  for  these  simula- 
tions because  that  seemed  long  enough  to  ensure  independence 
among  measurements  in  an  operational  system,  and  because  it 
reduced  the  computer  time  required  to  do  the  many  replica- 
tions.  A  few  simulations  using  three-second  and  one-second 
intervals  obtained  slightly  faster  convergence  though  little 
improvement  in  the  numbers  of  dropped  tracks. 
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4.  Optimized  fighter  PR  maneuver.   Since  the  rate  of  con- 
vergence to  the  true  target  state  evidently  increases  with 
the  rate  of  bearing  angle  change,  this  should  be  considered 
in  choosing  fighter  maneuvers.   A  pure  collision  course  is 
not  conducive  to  good  passive  ranging,  especially  for  the 

BO  EKF,  since  it  precipitates  no  bearing  change,  but  an 
alternating  lead-lag,  for  instance,  may  accomplish  virtually 
the  same  thing  tactically,  yet  allow  sufficient  bearing 
change  for  a  PR  solution.   The  "optimum"  maneuver  would 
undoubtedly  be  different  for  varying  scenarios  and  equip- 
ments.  Altitude  and  speed  changes  as  well  as  horizontal 
turns  should  be  considered.   The  APL  program  (Appendix  E) 
used  to  model  these  EKF ' s  can  be  easily  modified  to  accommo- 
date different  fighter  and  target  flight  paths,  and  so  could 
be  a  useful  tool  in  comparing  PR  maneuvers. 

5.  P-values  (observation  precision)  adjusted  to  actual 
equipment  specifications.   This  may  entail  varying  the 
P-values  as  a  function  of  range.   Simulation  results  using 
this  change  are  shown  in  Reference  1.   Other  equipment -peculiar 
characteristics  such  as  own-ship  navigation  error  would  also 
have  to  be  considered.   For  these  simulations  it  was  assumed 
that  the  distribution  of  angle  measurement  errors  was  known. 
The  effects  of  giving  the  EKF  wrong  precision  error  distri- 
bution information  should  be  investigated. 

6.  Interactive  system.   The  air crewman  may  have  a 
variety  of  sources  of  a  priori  information  with  which  to 
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make  an  initial  or  updated  estimate  of  target  state.   There 
should  be  a  means  for  him  to  insert  this  information  along 
with  a  confidence  level  or  estimated  variance,  and,  as 
mentioned  above,  there  should  be  a  set  of  reasonable  default 
values . 

7.  Measurement  variance  reduction.   For  example,  several 
measurements  could  perhaps  be  averaged  to  obtain  one  obser- 
vation input  which  is  less  affected  by  individual  outliers. 
This  could  be  particularly  important  for  the  first  few 
observations,  since  as  Aidala  [Ref.  8]  suggests,  they  are 
so  influential  in  the  "premature  covariance  collapse" 
problem. 

8.  Maneuvering  target  recognition  and  tracking.   This 
continues  to  be  an  unsolved  problem.   Ohlmeyer  [Ref.  1] , 
suggests  "that  small  levels  of  target  acceleration  can  be 
accommodated  within  the  filter  (using  methods  such  as)  the 
introduction  of  state  process  noise." 

9.  Parallel  filters.   If  computer  capacity  is  available, 
it  may  be  advantageous  to  have  more  than  one  EKF  operating 
at  the  same  time  on  the  same  target.   The  separate  filters 
might  use  alternating  observation  inputs,  or  perhaps  initialize 
at  different  times.   Besides  rendering  a  "second  opinion" 

this  could  be  helpful  in  the  maneuvering  target  situation. 

10.  Multiple  target  processing.   Since  fighter  maneuvers 
need  not  generally  be  precisely  designed  for  a  specific 
target,  the  fighter  could  be  making  his  maneuvers  against 
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a  particular,  perhaps  primary,  target,  and  concurrently  be 
computing  passive  ranging  solutions  on  other  targets  if 
his  equipment  has  sufficient  sensor  capability  and  computer 
capacity. 

11.   Elevation  angle-only  EKF.   There  could  be  situations 
for  which  the  fighter  would  want  to  maintain  a  collision 
course  in  azimuth  (precluding  bearings-only  passive  ranging) 
and  yet  desire  a  PR  solution.   This  could  conceivably  be 
accomplished  with  altitude  changes  and  an  EKF  which  requires 
only  elevation  angle  observations. 
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APPENDIX  A 
VALIDATION 

A.   VALIDATION  METHOD 

The  method  of  validation  used  here  is  borrowed  from 
Daly  [Ref .  6] .   In  essence,  validity  is  claimed  if  the  EKF 
tracks  in  range  variance  as  well  as  in  range. 

If  the  EKF  is  operating  properly  and  if  it  is  being 
provided  with  accurate  enough  information,  then  the  esti- 
mates of  range  variance  after  individual  tracking  sessions 
should  be  very  close  to  the  true  range  variance.   Compari- 
sons of  the  EKF  variance  estimates  over  many  tracking 
sessions  with  the  actual  (sample)  variances  provide  a  means 
of  evaluating  the  consistency  of  the  EKF  range  estimates. 
As  a  measure  of  this  consistency  we  will  use  the  statistic 
Kl  which  is  the  ratio  of  sample  range  variance  to  EKF- 
estimated  range  variance  at  the  end  of  a  tracking  session, 
averaged  over  n  distinct  sessions. 


.   n   (R  -  R  )^ 

^=1     ^R. 

1 

R.  is  the  EKF  range  estimate,  R.  is  the  true  range,  and 

2 

a_   is  the  EKF  range  variance  estimate,  all  at  the  end  of 

1 

tracking  session  i.   The  tracking  session  is  simulated 
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n  =  1000  times  using  the  same  values  for  all  input  param- 
eters, but  using  distinct  random  number  streams  for  measure- 
ment errors  and  initial  state  estimate  errors.   The  method 

2 
for  computing  R  and  a   is  described  below  m  Section  C. 

We  expect  that  if  our  theory  is  correct  and  the  EKF 
has  accurately  estimated  the  true  range  variance,  that  the 
value  of  Kl  will  tend  toward  unity. 

The  EKF  algorithms  were  applied  to  the  same  passive 
ranging  problem  (scenario)  which  was  addressed  in  Reference 
6.   In  this  problem  the  observer  and  target  are  both  surface 
ships.   At  time  0  the  target  bears  090°  at  20nm.   The  target 
proceeds  on  a  course  of  360°  at  10  kts,  while  the  observer, 

TABLE  V 
Kl  Values — Surface  Ship  Scenario 

Flat-Earth  Motion  Model 
1000  Replications 


p 

j;(4,4)    =    10^ 

1(4,4)    =    1 

10^ 

0.982 

1.015 

10° 

0.957 

0.015 

10-1 

0.991 

0.953 

10-2 

0.985 

0.959 

10-^ 

0.947 

0.976 

10-^ 

1.048 

0.955 

10-^ 

1.075 

1.091 

10-^ 

1.140 

1.086 

10-^ 

3.750 

0.941 

io-« 

7.461 

3.348 
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for  his  passive  ranging  maneuver,  proceeds  on  a  course  of 
180°  for  15  minutes,  then  turns  (instantaneously)  to  a  course 
of  360°  for  another  15  minutes.   A  total  of  11  observations 
are  taken  at  3  minute  intervals. 

B.   VALIDATION  RESULTS 

Table  V  illustrates  that  the  Kl  values  do  indeed 
generally  tend  toward  unity,  thus  supporting  our  claim  of 
validity.   It  is  notable  that  with  extremely  fine  measure- 
ment precision  the  Kl  values  no  longer  stay  near  1.   This 
finding  was  also  reported  in  Reference  6.   As  discussed  in 
Chapter  IV,  this  seems  to  be  a  result  of  the  range  variance 
decreasing  because  of  the  fine  precision,  whereas  the  actual 
range  errors  are  apparently  limited  in  their  decrease  by 
the  errors  inherent  in  the  EKF  due  to  its  linearization 
approximation  in  the  Measurement  Step. 

Results  in  Reference  6  were  obtained  using  an  EKF 
parameterized  with  range,  bearing,  velocity,  and  direction, 
rather  than  X,  Y,  X- velocity,  and  Y-velocity  as  used  here. 
The  author  reports  that  he  had  obtained  similar  results 
using  the  latter  parameterization,  but  that  when  using  the 
(X,Y,X,Y)  parameterization  the  Kl  values  stayed  close  to  1 
for  a  higher  degree  of  measurement  precision.   Results  con- 
tained here  appear  to  confirm  that. 

When  this  same  technique  was  applied  to  the  scenario 
described  in  Chapter  III  the  resulting  Kl  values  were  less 
clearly  convergent  to  1  (Table  VI) .   While  being  somewhat  . 
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TABLE  VI 
Kl  Values — Fighter  Scenario 

Flat-Earth  Motion  Model 
1000  Replications 


,02' 


1(4,4)    =  40' 


0.981 
0.932 
0.904 
0.853 
0.851 
0.938 


1(4,4)    =  40' 


.02' 


1.090 
0.893 
0.839 
0.831 
0.889 
1.146 


Bearing-Only 

1(4,4)  =  20^ 

0.893 
0.882 
0.868 
0.840 
0.799 
0.843 

Bearing  &  Elevation 

1(4,4)  =  20^ 

0.964 
0.846 
0.826 
0.801 
0.816 
0.983 


1(4,4)    =  10' 


0.897 
0.873 
0.835 
0.833 
0.834 
0.826 


1(4,4)   =  10' 


0.900 
0.832 
0.837 
0.774 
0.823 
0.829 


"close"  to  1  (±0.2)  the  Kl  values  varied  from  1  signifi- 
cantly more  than  those  for  the  simpler  problem  (±0.05) . 
Only  those  values  which  were  less  than  10  were  included  in 
this  computation  of  the  average  Kl's;  this  was  done  to 
eliminate  the  effect  of  those  (normally  few)  dropped  track 
Kl  values  which  diverged  drastically  from  1,  e.g.,  10  , 
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due  to  the  much  larger  number  of  iterations  per  tracking 
session.   This  limit  was  picked  arbitrarily  and  may  partially 
account  for  most  of  the  average  Kl's  being  less  than  1. 
The  variation  in  the  values  seems  to  infer  that  the  rate  of 
convergence  is  scenario-dependent  in  that  it  is  affected 
by  the  speeds,  distances,  and  geometry  involved. 

C.   COMPUTATION  OF  RANGE  VARIANCE 

The  covariance  matrix  for  this  type  of  parameterization 

has  terms  for  X,  Y,  and  A  (as  well  as  X  and  Y)  but  not  for 

2 
range  itself,  so  the  variance  of  the  range,  a  ,  is  not 

provided  directly,  but  is  obtained  as  follows: 

For  the  bearing-only  cases,  with  R,  R^,  and  Ry  repre- 
senting range,  and  X-and  Y-components  of  range  respectively 


R   =   (R^  +  R^)-^^^ 


9R    \     .  3R     \ 

so  TTo—  =  -TTr     ^rid 
X 


3R,,    R  '      SRy     R* 


The  first-order  (linear)  Taylor  Series  approximation 
(where  ^  indicates  an  estimated  value)  is: 


R   =   R  +  p-(R^-R^)  +  ^^ 


—  (R^-R^)  +  _(R^-R^) 


therefore 


2   .   ,3R  ,2  2  ,  ,3R  ,  ,3R  ,^   /^   „  x  ,  /3R  n  2.  2 


^R 


'  ^^^     'X   -^  ^BR^^^^aR^^^^^^^'^)  ^  ^3R;^  ^Y 
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or,    substituting  for  the  partial  derivatives. 


Similarly,  for  the  bearing-elevation  cases,  since 
R   =   (R?  .  R,2  +  R?)l/2 


(R^  +  R^ 


then 


^R  "   -^(R^a^  +  2R^RYCov(R^,RY)+R^a^+2RYR^Cov(RY,R^) 
+  R2a2+2R^R^Cov(R^,R^)). 


Note  that  Cov(R^,R^^)  =  Cov(X,Y)  where  X  and  Y  are  the  target's 
X  and  Y  coordinate  positions,  since  the  fighter  (observer) 
position  is  known. 
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APPENDIX  B 
EKF  REFERENCE  FRAMES  AND  MOTION  MODELS 

A.  "FLAT-EARTH"  REFERENCE  FRAME 

The  EKF ' s  for  both  the  bearing-only  and  bearing- 
elevation  observation  models  are  set  in  a  Cartesian 
coordinate  system  with  axes  X,  Y  and  A.   This  reference 
system  has  its  origin  at  0  altitude  directly  beneath  the 
fighter  at  time  0  (time  of  initial  observation) ,  and  Y-axis 
in  the  direction  of  the  first  observed  bearing.   Bearing 
and  course  are  measured  in  the  X-Y  plane  clockwise  from  the 
Y-axis . 

B.  MOVEMENT  IN  THE  "FLAT- EARTH"  MODEL 

Since  altitude  is  held  constant  for  the  fighter  and  the 
target,  movement  is  a  two-dimensional  problem.   For  example 
if  a  target  is  at  position  (X-|,Y,,A, )  at  time  1,  and  at  time 
2  has  moved  D  units  on  a  course  of  C,  then  his  new  position 
(X2/Y2,A2)  is  computed  by:   X^  =  X,  +  D  sin  C,    "^2  =  Y,  +  DcosC, 
and  A,  =   Aj. 

C.  SPHERICAL  REFERENCE  FRAME 

Although  the  EKF  algorithms  presented  here  utilize  a 
Cartesian  (flat-Earth)  reference  frame,  the  algorithms  are 
also  tested  using  fighter  and  target  positions  generated  by 
a  spherical  model.   Here  the  Earth  is  modeled  as  a  perfect 
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sphere  of  radius  3444  nautical  miles.   "Constant"  course  in 
this  model  means  a  great  circle  track  with  constant  alti- 
tude; speed  refers  to  ground  speed,  i.e.,  the  speed  of  the 
object's  projection  on  the  Earth's  surface. 

For  computational  ease  a  reference  system  is  again  based 
on  fighter  location  and  bearing  to  the  target  at  time  0. 
The  origin  of  this  (latitude,  longitude,  altitude)  spherical 
coordinate  system  is  defined  as  the  zero-altitude  point 
directly  beneath  the  fighter  at  time  0,  and  the  initial 
observed  bearing  to  the  target  is  defined  to  be  0.   (This 
may  be  thought  of  as  shifting  the  Earth's  coordinate  system 
so  that  the  intersection  of  the  equator  and  the  Greenwich 
Meridian  is  directly  beneath  the  fighter  at  time  0,  and  the 
first  observed  bearing  is  True  North) . 

D.   MOVEMENT  IN  THE  SPHERICAL  MODEL 

In  computing  movement  in  the  spherical  system  the 
following  rules  of  spherical  trigonometry  are  used  (refer 
to  Figure  B. 1) : 

Law  of  Sines: 


sm  a  _   sin  B     _   sm  y 

sin  A/E      sin  B/E   ~   sin  C/E 


Law  of  Cosines: 


cos  B/E   =   cos  A/E  cos  C/E  +  sin  A/E  sin  C/E 
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Figure  B.l.   Spherical  Trigonometry  Reference 

cos  6   =   -  cos  a  •  cos  y  +  sin  a    •  sin  y  *  cos  B/E 

where  E  is  the  Earth's  radius. 

If  in  this  coordinate  system  a  target  has  position 
(latitude , longitude, altitude)  =  (X, ,Y, ,A, )  and  Great 
Circle  course  C,  at  time  1,  and  if  by  time  2  it  has  moved  D 
units  at  constant  altitude,  the  new  position  (X_,Yp,Ap) 
and  course  C^   are  computed  by: 


Yy      =      sin   (sin  Y,  •  cos  D  +  cos  Y,«  sin  D  •  cos  C. ) 


X-   =   X,  +  sin   (sin  D  •  sin  C,  —  cos  Y-) 
2      1  1  •       z 


C2   =   (it  -  cos"  (sin  C,  •sin(X  -X, )  -sin  Y  -  cos  C-,  -cos  (X^-X,  ) 


X  (C^  T  Ic^D 


57 


and 


Figure  B.2.   Spherical  Movement 


^2   ~   "^1  • 
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APPENDIX  C 
FIGHTER  MANEUVERS 

Only  one  set  of  fighter  maneuvers  are  analyzed  in  this 
study.   Some  types  of  maneuvers  are  certainly  better  than 
others  and  the  EKF  algorithm  has  been  demonstrated  to  be 
robust  enough  to  operate  well  with  a  wide  variety  of 
different  maneuvers;  the  essential  features  are  that  there 
be  some  variation  in  motion  parameters  [Ref.  9]  and  that  the 
fighter  be  able  to  determine  with  reasonable  precision  his 
own  position. 

The  fighter  maneuvers  used  for  these  simulations  are  as 
follows : 

(a)  Upon  initial  target  observation  he  immediately 
(instantaneously)  sets  a  course  0.7  radians  (about  40 
degrees)  left  of  the  first  bearing  observation. 

(b)  The  fighter  maintains  a  constant  course  (constant 
speed  and  altitude  with  no  horizontal  turns--in  the  spheri- 
cal model  this  is  a  Great  Circle  track)  until  either  a 
pre-set  number  of  new  observations  have  been  taken,  or  until 
the  relative  bearing  angle  to  the  target  exceeds  0.9  6 
radians  (about  55  degrees)  right.   At  this  time  he  turns 
(again  instantaneously)  to  establish  a  new  course  0.7 
radians  to  the  right  of  the  most  recent  bearing  observation, 
and  similarly  continues  until  relative  bearing  exceeds  0.96 
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radians  left  or  until  a  set  nuiT±)er  of  observations  have  been 
taken. 

(c)   This  not-quite- symmetrical  zig-zag  pattern  continues 
until  a  set  number  of  total  observations  have  been  recorded 
or  until  the  target  has  passed  the  fighter  (bearing  obser- 
vation angle  less  than  -  y  or  greater  than  y)  . 
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APPENDIX  D 
ELEVATION  ANGLE  CORRECTION  FOR  EARTH'S  CURVATURE 

The  Extended  Kalman  Filter  algorithms  proposed  here  were 
developed  based  on  a  "flat-Earth"  motion  model.   To  enhance 
the  performance  of  the  bearing-elevation  EKF  when  using 
inputs  from  a  spherical  motion  model,  a  simple,  approximate 
elevation  angle  correction  was  developed. 

Referring  to  the  figure  on  the  next  page,  the  notation 

is  as  follows; 

a   =   true  elevation  angle  measured  from  the 
horizon 

a'   =   "corrected"  elevation  angle  to  be  input  to 
the  EKF 

R   =   line-of-sight  range 

E   =   radius  of  the  Earth  (assumed  here  to  be 
3444nm) 

A_,   =   altitude  of  target 

A   =   altitude  of  fighter 

Then  A^  -  A 


X    F 
a  '   -   [ — 5 ]  by  construction 

is. 


A^- A, 


J.    F 
a'   =   [ — p^ ]  by  small  angle  sine  approximation 

^  R^+(E+Ap)^-(E+A^)^ 

sin(-a)  =  sin(2-3)  =  cos  e  =  [ 2  R  (E+A^) ^ 

F 
by  law  of  cosines 

R^+(E+Ap)^-(E+A^)^ 

""      =   f 2  R  (E-HA^) ^  ^y  ^"^^^^  ^"^^^  ^^""^ 

F 

approximation 
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Figure  D.l.   Elevation  Angle  Correction 


a '-a   =   [ — =z — ]  +  [ o  T^  /r. — ; — ^i — 1 


R 


2  R  (E  +  A^) 


2,2.^       2 
T^f"  F 


R  -A^+2A„A„-A 


2  R  (E+Ap) 


so,  since  A  and  A^  are  "small"  and  their  difference  is 
"small". 


a '  -  a   = 


R 


2E 
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SO  a '  =  a  +  ypr  is  the  correction  (based  on  EKF-estimated 
range) . 

NOTE:   As  the  magnitude  of  A^-A„  increases  relative  to 

i   r 

range,  the  approximation  becomes  less  accurate,  but  as 
range  decreases  the  correction  goes  to  zero. 
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APPENDIX  E 
APL  COMPUTER  PROGRAM 

The  APL  program  shown  here  assumes  global  variables 
as  defined  in  the  initial  comment  section.   The  program 
updates  fighter  and  target  positions  as  described  in 
Appendices  B  and  C,  generates  random  observations,  and 
computes  corresponding  BO  and  BE  EKF  estimates.   Choice  of 
output  variables  and  programming  of  output  statistics  is 
left  to  the  user. 
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en 

C23 
C33 
C43 
C5] 
[63 
C73 
£83 
C93 

cio: 
cii: 
C12: 
C13: 
C14: 
C15: 
cu: 
C17: 
cia: 
C19: 
1:20: 
C2i: 
C22: 

C23: 
C24: 
[251 
L26; 
L27: 
C28: 
C29: 

C3o: 
C3i: 

C32: 
C33: 

[34: 

C35: 
C36: 
C37: 

C3a: 

C39: 

C4o; 

C4i; 
[42; 

C43: 
L44: 
C45: 
C46; 
C47: 

[48: 
[49: 
[5o: 
[5i; 
[52: 
[53: 
[54; 
[55: 
[56: 
[57: 
[58: 
[59: 
[60: 
[61: 
[62: 
[63: 
[64: 

C65: 

[66: 

[67 

[68: 


VARIABLE  DEFINXTIOHS 

DISTANCES  (SPEEDS)  ARE  IN  NM  (KTS)  -^3444 
ANGLES,  COURSES,  BEARINGS  ARE  IN  RADIANS 
2  AT  END  or  VARIABLE  NAME  INDICATES  BE  (VICE  BO) 

SIGJ  INITIAL  ESTIMATED    MATRICES  (AND  AFTER  MOVEMENT) 

PNi;    MATRICES 

SIGH*  ESTIMATED    MATRICES  AFTER  MEASUREMENT 

MU;  INITIAL  ESTIMATED  STATE  VECTOR  (AND  AFTER  MOVEMENT) 

MH;  estimated  state  vector  after  MEASUREMENT 

'^lr'^2!  ^  DIAGONAL  ELEMENTS;  Q*    Q  MATRICES 

MM, MV, MR, MX, MA,* 

HMU,DH,MHt 

ran*  function  mhich  calls  a  n\(0,1)  random  number 

delt;  time  between  observations  in  hours 

nn;  number  of  observations  between  turns 

fx,  ft,  fa,  fs,  fcrs*  fighter  coordinates,  speed,  course 

lsrc,  brg*  true  line-of-sight  range  and  bearing  to  target 

tx,  ty,  ta,  ts,  tcrs*  target  coordinates,  speed,  course 

txd,  tyd*  tgt  x  and  y  velocities 

THRG:  TRUE  HORIZ  RANGE  (FLAT-EARTH  MOTION  MODEL) 
GCRGl  TRUE  GREAT  CIRCLE  RANGE  (SPHERICAL  MOTION  MODEL) 
TRUN;  DISTANCE  COVERED  BY  FIGHTER,  TARGET  IN  DELT 
(0)  IF  ELEVATION  CORRECTION  APPLIED  (NOT  APPLIED) 
(SN  =  0)  IP  USE  SPHERICAL  MOTION  MODEL 
(SN  =  1)  IF  USE  FLAT-EARTH  MOTION  MODEL 
TRUE  ELEVATION  ANGLE 
1  ♦  MU,  MU2  INITIALLY  RANDOM  ABOUT  TRUE  STATE 


FRUN, 

P  =  1 
S  =  1 
5  =  0 

tela: 

VAL  = 


=  0  \    *<U»  '^"2  SET  AT  SPECIFIC  NUMERIC  ESTIMATES 
INITIALIZATION 

GCR6«.(-2)Q(((FA+l)*2)  +  ((TA+l)«2)-»-SRG»2)-=-2X(FA+l)xTA+l 

THRG*.((LSRG»2)-(TA-FA)»2)«0.5 

FRUN«.PELTxFS 

TRUHfDELTxTS 

BRG«.-1XMV[1;3+RANC(2+2XNUM)]XRC1J13«0.5 

TCRS4.BRG+TCSX  (01  )-i-180 

Tx«.  ( sx  ( "3 )  a  ( 3eGCRG )  x  igbrg  >  +snx  thrgx  Igbrg 

■'■T«-(Sx(-3)e|(leTX)x3a(Q0.5)-»'»G)+SNxTHRGx2eBRG 

TXDf-TSxlOTCRS 

TYD(.TSx29'''CRS 

TELA<-(Sx(-2)0(TA+l)X(l0GCRG)r-LSRG)+SNx(-3)G(TA-FA)iTHRG 

Z(.0,TELA+RANC(3+2xNUM)]xRR[2;23«0.5 

4Lx\VAL=0 

ROHV^RAN  RAN  RAN  RAN  RAN 

MUt-  4  1  tMU2«-  5  1  f  ((T5x((l9TCRS),2eTCRS)),0,THRG,TA)+RANVxSIGRAD«0.5 
ft 
It  MEASUREMENT 

ft 

A  EQUATIONS  2.2  -  2.4  PO**  BEARING-ONLY 

L:MRf((((MX<.MUC3n)-FX)«2)  +  ((«Y<.MUC4;3)-P>')«2)«0»5 
HMU«.  1  1  f  ("3)0((MX-FX)rMY-FY) 

PH«.  1  4  fO»Of  ((«Y-FY)H-MR»2)f  (FX-MX)rMRl2 

K«-SIG1+,X(^DH)  +  ,XB((DH+,XSIG1  +  .X($I>H))+RC1J13) 

MH<.(4,l)/>MU+l{+,X(((l,l)fZCn)-MV+HMU) 

5IGHf.(((4,4)f(l,4fO))-K  +  ,xDH)  +  .xSIGl 
ft 
ft  EQUATIONS  2.2  -  2.4  '^0'*  BEARING-ELEVATION 

MR2<-(  ( ( (>*X2<-MU2C3f  13)-PX)«2)  +  ((XY2<-MU2C4fn)-PY)t2)«0.5 

HMU2<-  2  1  f(("3)e((xx2-PX)-^>«Y2-FY)),(-3)e((MA2«-MU2C5»3)-P"ft)^»<R2 

DH2<-0,0»  (  (MY2-FY)^MR2t2)  »  (  (PX-MX2)  ■rMR2»2  )  f  Of  0»0 
DH2t-DH2,((FA-MA2)X(MX2-FX)-i.(MR2»3)+MR2X(MA2-FA)jl2) 
DH2*-DH2,((FA-MA2)X(MY2-FY)^(MR2n3)+MR2x(MA2-FA)t2) 
DH2f  2  5  fE'H2>(XR2)T((MR2«2)  +  (XA2-FA)t2) 
K2f(SIG2+,X(^DH2))  +  .xB<(£'M2+.XSI62+»X*DH2)+RR) 

**»2*-   5  1  f«u2+K2+,x((2  1  fZ)-MV2+HMU2) 
siGH2<-((5  5  f(lf5fO))-'<2+.xDH2}  +  ,xsiG2 
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C693     i«-i+l 

[70]       -»LCxIiHU¥ 

[71]    R 

C72]    ft    MOVEMENT 

[733  fl 

[74]    fl    EQUATIONS    2f5f2.6    '^OR    BEARXNG-43HLT 

[75]  lc;mu*.(phi  +  ,xmh)+mi* 

[76]   5IGl«.(PHI  +  »xSIGH+.X*PHI)+0 

[77]  A 

[78]  fl  EQUATIONS  2.5»2»6  ^Oft  BEARING-ELEVATIOH 
[79]   MU2«-(PHI2+,XMH2)+M*<2 

[80]  siG2«-(PHi2+,xSi6H2+,xl»PHi2)+Q2 
[81]  n 

[32]  M  UPDATE  FLAT  EARTH 

[83]  II 

[84]   -»LUx\S 

[85]   TX*.TX+TRUHxl9TCRS 

[86]   TYfrr+TRUNx29TCR5 

[87]   FX(.FX+FRUNxiaFCRS 

[88]   F"T>FT+FRUNx2eFCRS 

[39]   THRG<.(((TX-FX)t2)  +  (TY-FY)j2)t0.5 

[90]   LSRG<.((THRGt2)  +  (TA-FA)t2)«0»5 

[91]   BRG<.(-3)Q(TX-FX)iTY-FY 

[92]  t.ela4.(-3)q(ta-fa)tThrg 
[93]  41-LU 
[94]  A 

[95]  ftUPDATE  SPHERICAL  EARTH 

[96]  A 

[97]  i.u:TY<.(-i)a((ieTr)x2eTRUH)  +  (2eTY)x(leTRUN)xTCRS 
[983  Ft<.(-i)e((leFY)x2eFRUH)  +  (2eFY)x(ieFRUN)xFCRS 
[99]  Tx«.Tx+  ("Dec  igtruh  )  x  19(  txx^tx  >  ^2a"rYY*.TY 

[1003  P>«-PX+(-l)e(l9FRUN)xl8(FXX<.FX)r-2eFYY«.FY 

[101]  TCR5<.(xTCRS)x(9l)-(~2)9((l9TCRS)X(l9TX-TXX)xl9TYY)-(29TCRS)x2eTX-TXX 

[102]  FCRS<.(xFCRS)x(9l)-(~2)9((l9FCRS)x(l9FX-FXX)xl9FYY)-(29FCRS)x29FX-FXX 

[103]  GCRG<.(-2)9((l8TY)xlGFY)  +  (29TY)x(29FY)x2eTX-FX 

[104]   I-SRG<.(((FA+I)t2)  +  ((TA+1)«2>-2X(FO+1)X(TA+1)X29GCRG)J0.5 

[105]   PRG<-(-l)9(2GTY)x(l9TX-FX)^l9GCRG 

[106]   TELA<.<-2)9(TA+l)x(l9GCRG)^LSRG 

[107]  A 

[108]  LLU:^JJX\FY<TY 

[109]  LPMO 

[110]  «J«J:2«-(BRG+RAH[I]xRl)r(TELA+RAHn((2xNUM)-I-l)]xR2)+ETRG2xFT2 

[111]   J<-PCRS 

[1123   PCRS«.(Jx(HN(TURN)A(|J-ZCl])(0.96)  +  ((Z[l]+0.7)X((MM=TURH)A<(J-.2[l])(0))v( 

J- 

Z[l])i'0.96)+(2[13-0.7)X((HN=TURN)A((J-Z[l])>0))v(J-Z[l])i0.96 
[113]   HH<-l+HHxFCRS=J 
[114]   ->L 
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